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I.  INTRODUCTION 

An  object  may  be  treated  as  a  point  scatterer  for 
motion  estimation  of  small  (distant)  objects.  We  define 
a  distributed  object  as  one  that  cannot  be  adequately 
represented  as  a  single  point  scatterer  for  motion 
estimation  purposes.  A  distributed  object  model  is 
valid  if  the  size  of  the  olqect  is  of  the  same  order  as 
the  distance  between  the  object  and  the  observer. 

Many  papers  on  motion  estimation  of  distributed 
objects  have  appeared  in  the  literature.  See  [19] 
for  a  more  thorough  review.  The  measurements 
are  extracted  from  sequential  images  (or  frames), 
.-^pers  in  the  literature  have  dealt  with  a  variety  of 
measurement  systems  including  perspective  projections 
(4-8,  10-14],  orthographic  projections  (3-D  position) 

[2,  3,  15,  18],  and  range-Doppler  [9].  Here  we  deal 
with  a  measurement  vector  that  includes  the  3-D  (or 
2-D)  position  plus  Doppler.  Such  measurements  are 
available  from  monopulse  radar,  and  some  sonar  and 
laser  systems. 

A  distributed  object  can  be  modeled  as  a  surface 
or  as  a  finite  set  of  point  scatterers  [1].  The  point 
scatterer  model  is  more  appropriate  when  the 
wavelength  is  shorter  than  object  feature.  Here,  we 
assume  the  point  scatterers  model  We  also  assume 
the  scatterers  are  fixed  on  the  object  (Le.,  rigid  body 
motion). 

There  are  two  main  approaches  to  motion 
estimation  in  the  literature,  flow-based  methods  and 
feature  matching  methods.  For  the  point  scatterer 
model  of  a  distributed  object,  feature  matching  seems 
to  be  a  natural  choice. 

Feature  matching  methods  require  that  a 
correspondence  be  known  or  established  between 
features  in  successive  frames.  Algorithms  that  do 
not  require  the  establishment  of  correspondences 
have  also  been  pursued  [2,  3],  but  lack  the  occlusion 
tolerance  and  motion  parameter  uniqueness  of  the 
approach  described  here.  Methods  for  establishing  such 
correspondences  have  been  developed  in  [8,  9,  13].  The 
process  of  establishing  correspondences  is  prone  to 
error.  The  probability  of  making  an  error  is  especially 
high  when  estimating  motion  from  the  first  two  frames 
if  a  prior  motion  estimate  is  not  available.  Errors  from 
feature  mismatch  often  propagate  many  frames  before 
being  resolved  [9, 13]. 

On  startup,  rather  than  attempt  to  match  features 
by  the  nearest  neighbor  method,  we  propose  assuming 
feature  associations  over  enough  time  samples  such 
that  the  combined  measurements  uniquely  determine 
the  motion  parameters.  If  motion  parameters  are 
calculated  from  the  combined  measurements,  the 
motion  parameters  from  each  correctly  associated 
feature  are  identical  except  for  noise  effects.  If  there 
are  N  features,  there  arc  possible  feature 
associations  between  two  frames  of  data.  If  three 
frames  of  data  are  required  to  uniquely  determine  the 
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motion  parameters,  one  would  have  to  consider 
associations.  We  choose  lo  consider  only  two  frames 
and  only  salient  features  such  that  N  is  small,  lb 
have  sufficient  measurements  from  only  two  frames 
we  assume  the  measurements  include  position  (i.e., 
active  rather  than  passive  measurements)  plus  Doppler. 
The  use  of  only  passive  measurements  would  require 
more  frames  to  uniquely  determine  the  parameters  of 
the  same  motion  model.  It  would  also  require  proof 
that  the  parameters  of  this  specific  motion  model 
ate  uniquely  determined.  We  show  that  only  one 
feature  match  (6  measurements  in  2-D)  is  required 
to  uniquely  estimate  circular  motion  in  a  plane  (S 
unknown  parameters).  This  analysis  is  extended  to 
motion  of  a  3-D  object  when  the  orientation  of  the  axis 
of  rotation  is  known. 

Occlusion  (part  of  the  object  not  visible) 
complicates  the  association  of  features.  It  may  be 
caus^  glint  (phase  interference)  or  one  object 
shadowing  another.  It  may  occur  if  the  transmitting 
and  receiving  beams  are  poorly  positioned  or 
insufficiently  wide  to  cover  the  entire  object  It 
may  also  be  caused  by  aspect  dependence  or  range 
dependence  of  the  feature  scattering  strength  as 
in  the  following  examples.  Consider  a  scenario 
where  the  range  to  the  object  is  decreasing  by  orders 
of  magnitude.  The  number  of  resolvable  features 
increases  as  the  range  decreases.  Consider  also  a 
scenario  where  the  aspect  is  changing  with  time. 
Features  visible  at  one  aspect  may  not  be  visible  at 
another. 

Robustness  against  occlusion  by  filling  in  missing 
mea  surements  with  model  estimates  has  been 
proposed  [13].  This  assumes  a  good  motion  estimate 
is  available  and  the  number  of  features  is  constant 
lb  develop  an  algorithm  that  adapts  to  changes  in 
the  number  and  visibility  of  features,  we  propose 
matching  features  one  by  one  and  extracting  the 
motion  information  from  each  match.  Thus,  the 
number  of  features  and  some  (but  not  all)  of  the 
features  being  measured  are  allowed  to  change  each 
frame. 

Occlusion  invalidates  several  common  assumptions. 
It  is  common  to  represent  the  interframe  motion  as  a 
rotation  and  a  translation,  and  estimate  the  translation 
by  assuming  the  average  of  the  feature  locations  is 
fbeed  with  respect  to  the  object  [2,  3,  9, 18].  Under 
occlusion  the  average  of  the  feature  locations  is  not 
fixed.  It  is  frame  dependent  even  without  consideration 
of  measurement  noise.  Object-centered  coordinate 
systems  [13-15]  are  inherently  intolerant  of  occlusion. 

Because  the  size  of  the  object  is  of  the  order  of  the 
range,  Doppler  cannot  be  treated  as  “cross-range”  as 
is  commonfy  done  in  radar.  For  this  work,  Doppler 
is  treated  as  a  measurement  of  range-rate.  Inclusion 
of  Doppler  as  a  measurement  invariably  leads  to  a 
nonlinear  relationship  between  measurements  and  the 


estimated  motion  parameters.  Therefore  uniqueness 
is  not  guarenteed  and  it  is  necessary  to  analyze  the 
existence  and  uniqueness  of  the  motion  parameters. 

The  work  is  organized  as  follows.  In  Section  II  the 
measurements  are  discussed.  In  Section  III  the  motion 
model  is  given  with  insights  into  the  limits  that  are 
placed  on  the  model  1^  the  occlusion  assumption.  This 
is  followed  in  Section  IV  by  analysis  of  the  uniqueness 
and  existence  of  the  motion  parameter  given  the 
measurements.  Finalfy,  in  Section  V  the  sensitivities 
of  the  calculated  motion  parameters  to  errors  in 
measurements  are  derived. 

II.  MEASUREMENTS 

The  measurement  model  is  intended  for  an 
active  (transmitting  and  receiving)  system  where 
the  transmitted  waveform  is  sufficiently  narrow 
in  bandwidth  so  that  the  time  compression  of 
the  waveform  due  to  motion  of  the  object  can  be 
interpreted  as  a  Doppler  shift.  Given  that  assumption, 
range-rate  can  be  calculated  exactly  from  the 
transmitted  and  received  frequencies,  /,  and  by 


where  c  is  the  speed  of  the  sound. 

We  assume  the  system  has  two  sensors  on  the  order 
of  a  wavelength  apart.  The  direction  of  arrival  can 
be  estimated  from  the  difference  in  phase  between 
sensors.  The  wavelength  is  assumed  small  with 
respect  to  the  object  structure  so  the  sonar  return  is 
dominated  by  specular  reflections,  thus  justifying  the 
representation  of  the  object  as  a  set  of  point  scatterers. 
We  also  assume  that  the  resolution  of  the  transmitted 
pulse  is  sufficient  to  resolve  the  features  of  the  object. 

III.  MOTION  MODELS 

Models  for  motion  estimation  of  point  objects 
use  parameters  such  as  position  and  velocity.  A 
motion  model  for  distributed  objects  must  describe 
the  motion  of  each  feature  on  the  object.  One  could 
build  a  distributed  model  by  letting  each  point  have 
its  own  motion  parameters  and  add  the  constraint  that 
feature-to-feature  fluctuations  in  the  parameters  are 
small  Rather  than  add  this  complexity,  we  assume  the 
motion  parameters  are  constants. 

One  approach  to  representing  distributed  motion 
with  constant  parameters  is  to  describe  the  motion 
of  a  reference  point  on  the  object  and  the  relation  of 
all  features  to  it  Another  approach  is  to  describe  the 
motion  of  the  whole  rigid  object  such  that  the  motion 
parameters  describe  the  motion  of  each  and  every 
feature  on  the  object.  An  equivalent  definition  is  that 
the  parameters  that  describe  the  motion  of  the  object 
as  a  whole  are  observable  from  measurements  of  any 
feature  on  the  object.  The  motion  parameters  in 
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such  a  model  arc  herein  called  “common”  motion 
parameters. 

The  reference  point  model  is  poorly  defined  when 
the  reference  point  is  not  directly  measurable.  If  an 
arbitrary  point  on  the  object  is  chosen,  the  position  of 
that  point  can  be  updated  with  time  using  estimated 
motion  parameters.  With  uncertainty  in  the  motion 
parameters,  the  measurement  uncertainty  of  the 
refereiKX  position  always  increases  with  time.  Unless 
measurements  of  the  reference  point’s  position  can  be 
obtained,  the  reference  point  model  is  not  viable  for 
estimation  purposes.  If  Ae  reference  point  is  an  object 
feature,  that  feature  may  become  unmeasurable  due  to 
oodusioa  If  the  reference  point  is  the  object  centroid 
(average  of  all  visible  features),  its  measurement  is 
affectt^  by  the  occlusion  of  any  feature.  In  our  model, 
we  assume  that  the  features  are  fixed  on  the  object 
and  are  visible  for  at  least  two  successive  frames.  The 
centroid  is  allowed  to  vary  &om  frame  to  frame,  lb 
add  robustness  against  occlusion,  the  common  motion 
model  is  used  for  motion  estunatioiu 

However,  the  common  motion  model  also  has  a 
drawback.  The  common  motion  model  for  a  circular 
(rotating)  trajectory  is  poorly  defined  for  a  straight-line 
(nonrotating)  trajectory.  The  reference  point  model 
is  well  defined  on  the  boundary  |)etween  circular  and 
straight-line  trajectories.  It  is  to  generate  common 
motion  models  for  both  circular  and  straight-line 
trajectories.  Therefore  both  common  motion  models 
represent  equivalent  motion  at  the  boundary. 

lb  derive  the  reference  point  motion  model 
we  assume  the  object  is  moving  with  a  constant 
angular-velocity  on  a  circular  trajectory  in  a  known 
plane  [20].  Five  parameters  are  needed  to  describe 
the  motion  of  the  reference  point;  the  initial  position 
Xo,yo>  speed  V,  initial  heading  ho,  and  heading  rate  u). 

For  a  distributed  object,  we  add  structure,  the 
position  of  the  additional  features  relative  to  the 
reference  point  which  is  denoted  as  (u,-,  v,)  ^ere  u,- 
is  the  position  component  of  the  ith  feature  in  the 
direction  of  the  heading  and  v,-  is  the  component  along 
the  perpendicular  direction  as  shown  in  Fig.  1.  The 
position,  Pi(t),  and  range-rate,  ^,(r),  for  the  ith  feature 
without  noise  are  given  by 


x,(r)  =  Xo  +  a,cosA(r)  —  v,sinA(f) 

+  y  f  COSA(T)dT 

Jo 

(2) 

y,(r)  =  yo  +  Ui  sin  A(r)  +  v,cosA(r) 

+  Fy  sinA(T)dr 

(3) 

A(r)  =  Ao  +  wt 

(4) 

(5) 

(6) 

where  T  denotes  the  transpose. 


R*.  1.  “Common”  parameter  motion  model  of  distributed  object. 


Note  that  the  observer  need  not  be  at  the  center 
of  the  circle.  The  heading  rate  w,  and  the  center  of 
rotation  S  are  common  motion  parameters.  They 
are  the  same  for  aU  features  on  the  object  With  the 
designation  of  an  increment  in  time,  they  constitute 
a  transformation.  Furthermore,  the  parameters  (of 
the  transformation)  are  time  invariant  The  relation 
between  the  reference  point  model  and  the  common 
motion  model  is  as  follows: 


S  = 

Qi  = 

Ho  = 

RAO  = 


xo-  —  sinAo 
u 

V  ^ 
VoH — cosAo 

(j 


u(i) 

v(0-^ 


[cosAo  -sinAo' 
sinAo  cosAo  . 

coscjf  -sinwf 
sinwr  cosut 


(7) 

(8) 

(9) 

(10) 


P,(f)  =  5  +  /^(f)//oG,.  (11) 

The  model  can  be  further  simplified  by  letting 
Gi  =  H(iQi  which  yields 


Pi(f)  =  S  +  R,,{t)Gi.  (12) 

This  simplification  leads  to  no  loss  of  generality 
because  the  matrix  Ho  only  orients  the  object-centered 
coordinate  system. 

As  mentioned,  this  parameterization  has  a 
drawback.  As  the  heading  rate  approaches  zero, 
the  distance  between  the  object  and  the  center  of 
rotation  approaches  infinity.  For  this  case  (straight-line 
motion)  a  different  common  motion  mcxlel  is  used. 

The  reference  point  model  with  u  =  0  is  equivalent  to 
the  following  common  motion  model  with  the  velocity 
components,  F,  =  K  cqs(Ao)  and  Vy  =  V  sin(Ao),  as  tte 
common  motion  parameters.  The  model  becomes 


The  range-rate  measurement  is  given  by  (6).  For 
straight-line  motion,  there  is  no  need  to  distinguish 
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between  the  common  motion  and  the  reference  point 
models. 


IV.  EXISTENCE  AND  UNIQUENESS 


The  relationship  between  parameters  and 
measurements  for  the  circular  trajectory,  common 
motion  model  is  nonlinear.  Therefore,  having  more 
measurements  than  unknowns  is  not  sufficient  to 
establish  the  uniqueness  of  the  motion  parameter 
solution.  Furthermore,  a  solution  may  not  exist  In 
this  section  both  existence  and  uniqueness  of  the 
common  motion  parameters  are  analyzed  for  an 
object  on  a  circular  trajectory.  A  method  is  given  to 
distinguish  straight-line  and  circular  trajectories.  Once 
a  straight-line  trajectory  is  distinguished,  the  existence 
and  uniqueness  analysis  becomes  trivial  witft  position 
measurements  only.  Wb  concentrate  on  analy^g  the 
circular  trajectory  while  extending  some  anafysis  to 
straight-line  trajectories. 

Circular  motion  caimot  be  uniquely  determined 
from  position  measurements  at  two  successive  times. 
(An  infinite  number  of  circles  can  be  drawn  through 
two  points.)  The  ambiguity  is  resolved  using  range-rate 
measurements  in  addition  to  positioit 

Let  the  ith  object  feature  be  observed  through  2-D 
position  Pi(t)  and  range-rate  r,(r)  (from  Doppler) 
measurements  at  successive  times  t  =  ti,t2  given  by 


P.(t)  =  S  +  i?w(0C7,  (14) 

fi(t)  =  (15) 

Beginning  with  these  six  measurement  equations 
in  the  five  unknown  motion  parameters,  u,  5,  and 
Gi,  v/e  use  substitution  to  reduce  the  problem  to 
two  transcendental  equations  in  the  one  unknown 
parameter  u.  Differentiation  of  P,(t)  gives 

Pi(t)  =  K(t)Gi  (16) 


=  wBRu(t)Gi 


where 


The  change  in  position  is 


APi  =  Pi(l2)-Pi(tl) 


(17) 

(18) 


(19) 

(20) 


where  the  subscript  k  has  been  added  to  distinguish 
equations.  Both  equations  are  clearly  a  function  of 
both  {]  and  <2-  Further  simplification  is  possible  using 
p  =  to  scale  and  defining 


A,{tk)  =  II AP,  11/(21,,  |r.(r*)l) 

(23) 

'Piih)  =  sgn(/*  - 

+  2 

-  f  sgn(^(^*))  (24) 

Oi(ik)  =  arctan 

rp,(/*)TpAP,i 

(25) 

Piitk^APi  \ 

r  1 

/>o 

(26) 

sgn(0  =  1 

r  <0  ■ 

These  substitutions  yield 

sinp/p  =  Ai(tk)(X>s(j>  -  rpi^U)),  k  =  1,2 

(27) 

which  is  the  basis  of  our  uniqueness  and  existence 
analysis.  Since  (27)  is  really  two  equations,  for  clarity 
we  use  the  word  roots  to  mean  the  solution  of  a  single 
equation.  We  use  the  word  solution  in  referring  to  both 
equations  simultaneously.  Because  the  above  derivation 
involved  dividing  by  ri(tk),  special  considerations  are 
required  when  r,(4)  =  0- 

If  we  let  p  be  the  solution  of  (27),  the  center  of 
rotation  is 

S  =  IP.(t,)  +  P,(/2)]/2  +  (cot(^)/2)flAP,.  (28) 

Clearly  S  exists  and  is  unique  if  a  solution  of  (27), 
p,  exists  and  is  unique,  respectively.  Therefore  the 
focus  is  on  the  existence  of  a  solution  to  (27)  and  its 
uniqueness. 

A.  Motion  Classes 

We  define  the  following  exceptional  classes 
of  motion.  Let  C\  be  straight-line  motion.  Let 
C2  be  circular  motion  for  a  feature  that  is  the 
center  of  rotation  (||C7,j|  =  0).  Let  C3  be  circular 
motion  for  a  feature  that  has  completed  a  full  circle 
between  samples  (p  =  m,  n  0,  n  €  Af).  Let  C4 
be  the  nil  motion  of  a  stationary  feature.  C4  can  be 
mathematically  described  by  the  straight-line  motion 
parameters  with  Vf  =  Vy=  0.  Note  that  (21)  and  (17) 
are  not  valid  for  motion  classes  C\  and  C4.  'Diere  is 
reason  for  concern  that  (27)  does  not  apply  to  this 
case.  However,  by  substituting  the  common  motion 
model  for  straight-line  motion  into  (27)  we  get 


=  2sm(u)t4)BRu(ta)Gi  (21) 

where  =  (t2  -I-  ti)/2  and  tj  =  (t2  - 1\)/2.  Substituting 
(21)  into  (17)  to  eliminate  Gi  and  substituting  for  P,(r) 
gives  the  pair  of  equations 

ri(tk)  =  (wP,(t*)'’'P„(rt  -t«)AP,)/(2||P,(rt)|lsin«ra), 

k  =  1,2  (22) 


sin  p/p  =  cosp  -I-  sinpsgn(rt  -  fa)tan(d,(ti)) 

k  =  1,2.  (29) 

Clearly  p  =  0  is  always  a  root.  Therefore  (27)  is  valid 
for  Vie  Cl. 

Define  X>,-  as  the  motion  class  of  the  ith  feature. 

The  following  lemmas  determine  if  P,-  belongs  to 
exceptional  classes  C2,  C3,  or  C4. 
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Fig.  Z  Object  feature  on  a  circular  trajectory  and  observer  outside 
the  drde. 

Lemma  1  Motion  classes  0i  and  Ct  are  physicalfy 
indistinguishable. 

Lemma  2  e  C3  =»  ||AP,||  =  a 

Lemma  3  Vi  €  C2UC4  HA^Pill  =  0 and  ri(t)  =  Q 

Lemma4  IIAPill  =0=»Di  eCaUCaUCs- 

Proof.  Using  the  circular  motion  model,  the  proof 
for  motion  classes  C2  or  C3  follows  from 

APjAPi  =  4sin2p  GjCi.  (30) 

Using  the  straight-line  motion  model,  the  proof  for 
motion  class  C4  follows  from 

AP7APi=^4tj(y^  +  V^).  (31) 

□  • 

By  Lemma  4,  if  |1AP,||  =  0  we  conclude  Vi  € 
C2UC3UC4.  But  if  ||AP,1|  a  0  and  f,(r*)  jft  0,  A  =  1  or 
2  we  further  conclude  P,  €  C3.  However,  there  exists 
a  subset  of  C3  such  that  f,(rjt)  =  0,  A:  =  1,2  which  is 
visibly  indistinguishable  from  C2UC4. 

B.  Existence  of  Motion  Parameter  Solution 

Assume  Vi  ^  C2  U  C3  U  C4.  The  measurements 
enter  into  (27)  only  through  the  functions  Ai{tk)  and 
tl>i(tk).  Given  Pi(t*),  AP;  €  72^  -  {(0,0)}  and  fi(r*)  € 
[-M,M]  for  an  appropriate  value  M,  Ai{tk)  and 
ipiitk)  map  onto  the  intervals  (0,oo)  and  (j>  -  ir,p  +  jr], 
respectively.  Their  domains  are  more  restricted  in 
special  cases. 

Consider  a  feature  moving  on  a  circular  trajectory 
with  the  observer  outside  the  circle  as  shown  in  Fig.  2. 

In  Rgs.  2-7  the  trajectory  of  P,(ii)  begins  at  the  “o” 
and  ends  at  the  The  trajectory  of  Pj(f2)  leads  that 
of  Pi(ti)  by  the  angle  2p.  Here  p  -  0.4.  As  the  feature 
moves,  ^,'(/i)  and  ^i{t2)  take  on  sampled  values  along 
the  trajectory  shown  in  Fig.  3.  As  a  feature  completes 
one  circle,  i/',-(ri)  cycles  through  its  domain  twice. 

If  the  observer  is  inside  the  trajectory  circle  as 
shown  in  Fig.  4,  the  trajectory  of  ^i(fi)  changes  form 
as  shown  in  Fig.  5.  'N^riables  ^i>i(tk),  k  =  1,2  never 
take  on  values  on  the  interval  (p  -  arccos(do/d),  p  + 
arccos(do/d)). 

Ebr  a  feature  on  a  straight-line  trajectory,  the 
trajectory  and  corresponding  ^’■(^i)  ^■(^2) 


*  jocaliow  am  trajectory 

Fig.  3.  IVaJectories  of  and  V’l'Oz)  circular  feature 
trajectory  and  observer  outside  the  drde. 


Object  feature  on  a  circular  trajectory  and  observer  inside 
the  drde. 


Fig.  5.  Hajcctories  of  for  circular  feature 

trajectory  and  observer  inside  the  drde. 


Fig.  6.  Object  feature  on  a  straight-line  trajectory. 


*  locatioo  os  Ifoieclacir  * 

Fig.  7.  Hajectories  of  0,(tt)  and  ff>i(t2)  for  straight-line  feature 
trajectory. 

trajectories  are  shown  in  Figs.  6  and  7.  Here  V’i(fi)  and 
^i(t2)  take  on  the  value  zero  only  if  the  observer  is  in 
the  path  of  the  feature  trajectory.  They  approach  zero 
as  the  feature  range  (llPi(fi)||  or  HP, (12)11)  approaches 
infinity. 


Fig.  4. 
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1  * 

O.SS<38 

12 

0.61707 

1  S 

0.933M 

13 

0.54839 

1  « 

0.M3S1 

U 

0.46743 

1  ^ 

0.86783 

15 

0.31831 

\^th  these  preliminaries,  we  next  investigate 
the  existence  of  roots  of  (27)  for  each  k  separately. 
Conditions  for  existence  of  roots  are  as  follows. 

Theorem  1  If  I(V’i(^*))2x|  <  Jr/2  there  is  a  value 
Aoh  =  .i4crit(V’i(^*))  satins  the  following:  Equation 
(27,  t  =  tk)  has  two  roots  on  the  interval  p  e  (-x  x]  iff 

The  subscript  2x  indicates  constraint  modulo  2x  to 
the  interval  (-x.x).  The  proof  is  shown  graphically  in 
Fig.  &  Note  the  main  lobe  of  the  sin  pjp  always  has 
twice  the  width  of  the  sinusoid. 

Corollary  l  If  |(V’i(^*))2T|  <  and  two  roots  of 
(27,  t  —  tk)  exist  on  the  interval  p  6  (-Jr.x],  those  roots 
are  identical  iff  Ai(tk)  = 

Ai(tk)^  Aaitii’idk))  defines  the  boundary  for  the 
existence  of  roots  to  Q.T).  If  Ai(tk)  <  Acin(^i(ik))  no 
roots  exist  However,  for  the  noiseless  case,  Ai(tk) 
is  always  greater  than  or  equal  to  Aan^ipiitk))  and 
equality  is  only  achieved  if  sample  times  happen  to  fall 
at  specific  time  instants.  The  noisy  measurement  case 
is  treated  in  Section  V 

The  function  Aaiiipiitk))  can  be  calculated 
numerically  by  noting  that  both  functions  in  Fig.  8  and 
their  derivatives  are  equal  when  Ai(tk)  =  AcTit{i>i{tk)). 
Let  Petit  denote  the  value  of  p  at  the  point  of  tangency. 
Then  we  can  calculate  Aan(i>i(tk))  from 


)«•(#((<»)  -  r) 

Fig.  8.  Graph  of  (27)  showing  the  existence  of  0  or  2  roots  as  a 
function  of 

Theorem  1  is  useful  for  testing  whether  roots  exist, 
but  the  following  extension  is  more  useful  in  proving 
the  theorems  that  follow. 

Let 

Utk)  =  ^Perit)  =  arctan  ( 

\  Pah  j 

(35) 

represent  the  invertible  mapping  of  (33). 

THEOREM  2  Given  V»,(rt>  ></(f*)  =  A^a  iff  P  =  Peril  = 
i-\Utk))- 

The  proof  follows  from  (32).  Even  though  pcni 
is  a  double-valued  function  of  the  ambiguity  is 
resolved  by  knowing  the  sign  of  V’i(tt). 

Next  we  consider  conditions  for  which  roots  always 
exist 

Theorem  3  If  -x  <  (^,(f*))2»  <  -x/2  or  xji  < 
(V’/(^*))2»  <  (27)  has  two  roots  on  the  interval  p  e 

(x,x]. 

The  proof  also  follows  from  Fig.  8. 

If  it  is  known  a  priori  that  the  observer  is  inside  the 
feature’s  circular  trajectory,  the  following  theorem  is 
useful.  With  a  sufficiently  high  sample  rate  (sufhciently 
small  p),  two  roots  always  exist  Let  ((p)  =  p  -  ?(p)- 
This  is  also  an  invertible  mapping. 


Aai,\Utk)) 


Perit^  +  sinVoi,  -  2pcrit  sin  Pdit  cos  Peril 
Perit^ 


(32) 


. _ /.I.  _  Pah  sin  Peril  COS  Peril 

tan(V>,(ffc))  = - ri - 

Sm  Peril 


(33) 


by  solving  (33)  numerically  for  pah-  Results  are 
listed  in  Ihble  I  which  is  interpreted  using  Aah{x)  = 
Aah(—x)  Vx.  It  is  interesting  to  note  that  Aait(x/2)  = 
l/x. 

Theorem  1  with  substitution  from  (23)  gives  an 
upper  bound  on  the  range  rate  of  the  ith  feature. 


\n(tk)\  < 


IIAfill 

2tdAah(rl}i(tk)) 


(34) 


as  a  sufficient  and  necessary  condition  for  roots  of  (27) 
to  exist  if  |(V’i(t*))2x|  <  ff/2. 


'HtEOREM  4  If  the  observer  is  inside  the  circular 
trcqectory  of  the  feature  and  \p\  <  (“'(arccos(do/d)) 
then  p  56  C^(rpi(tk))  'itk- 

Proof  of  Theorem  4  The  proof  follows  from 
Fig.  5.  The  function  ^(p)  is  a  monotonically  increasing 
and  passes  through  the  origin.  Therefore  a  plot  of 
Peril  versus  time  has  the  same  form  as  the  plot  of 
‘tl)i(tk)  in  Fig.  S.  It  follow  that  there  exists  a  value  pmi 
corresponding  to  p  -  arccos(do/d)  in  Fig.  5  such  that 
Peril  never  exceeds  p„i  during  the  first  half  of  the 
^i(t\)  trajectory.  Similarly,  there  exists  a  value  pm2 
corresponding  to  p  +  arccos(do/d)  in  Fig.  5  such  that 
Peril  never  decreases  below  pm2  during  the  second 
half  of  the  V’,'(r])  trajectory.  If  p  is  such  that  p^i  < 
p  <  Pm2i  then  p  p^rii  Vr*,  A:  =  1,2.  Ti-ansforming  by 
applying  ^(')  yields 

p  -  arccos(do/d)  <  ^(p)  <  p  +  arccos(do/d)  (36) 
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(a)  (1^  (c) 

Fig.  9.  Eqiution  (27,  t  =  fi)  is  (a)  inconsistent,  (b)  consistent  with 
one  toot,  and  (c)  consistent  with  both  roots  o(  (27,  t  =  I2). 

and 

IpI  <  <■  *(arccos(do/d)).  (37) 

□ 

Consider  the  special  case  of  ri(tic)  ~  0. 

Equation  (27)  has  the  two  roots  p  =■  tpi(tk)  3: 7/2. 
Clearly,  roots  always  exist 

Consider  the  case  of  straight-line  motion  (D,-  €  C\). 
With  the  following  minor  conditions,  two  roots  always 
exist 

Theorem  S  If  the  feature  is  on  a  straight-tine 
trajectory,  the  ^server  is  not  located  on  the  trajectory, 

ond  ||P.(fjk)||  <  <30,  dun 

The  proof  follows  from  Rg.  7. 

lb  this  point,  we  have  examined  (27)  for  each  time 
separately.  Using  (27)  for  both  instants  of  time  ti  and 
t2,  we  examine  the  existence  as  well  as  the  uniqueness 
of  the  solution.  The  existence  condition  is  stated  as 
follows. 

Lemma  5  roots  exist  for  both  equations  (27,  /:  =  1) 
and  (27,  fc  =  2),  a  solution  exists  for  (27)  the  pair 
iff  one  root  of  ^7,  A:  =  1)  is  identical  to  one  root  of 
(27,  A  =  2). 

This  is  illustrated  in  Fig.  9.  In  Fig.  8,  (27)  is  plotted 
showing  variations  of  A;(tk)-  Here  (27)  is  again 
plotted,  but  Ai(tk)  is  constant  and  both  equations 
(k  =  1,2)  are  shoW. 

Generally,  it  is  a  good  idea  to  stay  away  from 
the  existence  boundary  (Ai(t)  =  /lent)-  We  show  that 
motion  parameters  are  more  sensitive  to  measurement 
enor  there.  The  following  theorem  gives  conditions 
such  that  roots  of  both  equations  are  simultaneously  on 
the  existence  boundary. 

UtEOREM  6  Assume  the  roots  of  (27,  A  =  1)  are  on 
the  existence  boundary  and  that  die  roots  of  (27,  A  =  2) 
satisfy  the  existence  conditions  of  Lemma  5.  Then  the 
roots  of  (27,  A  *=  2)  are  also  on  the  existence  boundary 
iff  the  ob^ct-observer  geometry  is  one  of  the  ambiguous 
geometries  defined  fiih)  =  (discussed  later). 

Proof  of  Theorem  6  Although  p  is  unknown,  we 
know  p  =  />crii  =  A  =  1,2.  Applying  the 

one  to  one  mapping,  4,  yields 

fi(t2)  =  i>i(ti)-  (38) 

The  converse  is  straight  forward.  □ 


C.  Uniqueness  of  Motion  Parameters 

What  if  two  values  p^^^  and  p^^  exist  which  are 
roots  of  both  equations  (27,  A  =  1)  and  (27,  A  =  2)? 
The  uniqueness  of  the  solution  is  stated  in  the 
following  theorem  which  is  proved  with  the  aid  of 
subsequent  lemmas. 

theorem  7  Let  0i(ti)  be  the  angle  between  Pi(h)  and 
APi,  and  6i(t2)  be  die  an^  between  Piitj)  and  AP, 
(0,(ti)  and  6i(t2)  are  consistent  with  earlier  definitions.) 
Assume  a  solution  exists  for  (27)  The  solution  is 
ambiguous  (two  distinct  solutions  exist)  iff 

»i(ti)  +  Hh)  =  0.  ti(t2)  =  ri(t{)  (39) 

or 

Hh)  +  0i(t2)  =  X,  i-i(t2)  =  -r,(ri).  (40) 

Lemma  6  The  equation 

A,(ri)cos(p  -  V>/(ti))  =  Ai(t2)cos(p  -  1pi(t2)) 

(41) 

is  either  true  for  all  p,  or  has  two  solutions  on  the 
interval  p  e.  (-x,x]  and  p^  =  pf'l  +  x.*  . 

lb  prove  Lemma  6,  we  form  a  function  by 
subtracting  the  right-hand  side  of  (41)  from  the 
left-hand  side.  The  function  is  a  sinusoid  of  the  same 
period  and  the  roots  are  related  by  =  pO)  +  jr. 

By  application  of  the  Intermediate  'Vhlue  Theorem  to 
this  function,  we  conclude  it  has  two  roots  on  (-tr,x], 
unless  it  is  zero  everywhere,  in  which  case  all  values  of 
p  are  roots. 

L£MMA  7  T]vo  values,  pf^l  and  pf^  ^  pf’)  exist  which 
are  roots  of  both  (27,  A  =  1)  and  (27,  k  =2)  iff 

Ai(ti)cos(p  -  rpi(ti))  =  A(r2)cos(p  -  rpi(t2))  V  p. 

(42) 

Proof  of  Lemma  7  If  pf*)  and  pf^)  are  roots  of  both 
equations  (27,  A  =  1)  and  (27,  A  =  2)  and  p(*)  jk  pf^, 
then 

^  =  Ai(ti)cos(p  -  ipi(ti)) 

=  A,(r2)COS(p  -  ll!i(t2)),  p  =  p^'^ p^^^ 

(43) 

Since  sin p/p  >  0  for  p  €  (~x,x]  and  sin pjp  =  0  only 
for  p  =  X,  we  can  assign  the  roots  to  p^’^  and  p^ 
such  that  Ai(rk)cos(p(*)  -  ^,(r*))  >  0,  A  =  1,2  and 
Aj(rt)cos(pW  -  ipi(tk))  >  0,  A  =  1,2.  Assume  there 
exists  some  value  p  £  (-x,x]  such  that  (43)  is  not 
true.  Then,  given  that  pf'^  satisfies  (43),  by  Lemma  6, 

’When  angles  are  added,  we  imply  that  the  result  is  constrained  to 
the  interval  (-jt.x). 
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(a)  (b) 

Fig.  10.  Ambiguous  geometiies  for  (a)  d|((|)  +  0i(<2)  =  0,  and 
(b)  e.(/i)  +  ft(/2)  =  !r. 


Fig.  11.  Ihijectories  associated  with  ambiguous  geometries, 
(a)  Symmetric,  (b)  Asymmetric. 


p(^  s  pO)  +  T  is  the  other  root  This  leads  to  the 
contradiction 

>4i(r*)cos(p<*)  -  <0  *  =  1,2.  (44) 

The  converse  follows  from  Fig.  9(c).  □ 

Lemma  8  Since  Ai(ti),Ai(t2)  >  Q 
/4,(fi)cos(/i  -  rpi(tx))  =  Ai(t2)cos(p  -  V’,(f2))  V  p 

=>  Mil)  =  Mi2)-  (45) 

Proof  of  Theorem  7  Assume  the  solution  is 
ambiguous  (i.e.,  pi^^  and  p^^  ^  are  roots  of 
both  equations  (27,  A:  =  1)  and  (27,  k  =  2)).  Then  by 
Lemmas  7  and  8  =  V>,(/2)-  First,  if  we  assume 

ri(t2)  =  in  (24) 

0i(t2)  =  (46) 

Alternately,  if  we  assume  that  r,(r2)  =  in  (24) 

®»(^2)  =  -^<(^0  +  ’T-  (47) 


trajectories  are  dissimilar  as  shown  in  Fig.  11(b). 
Ambiguities  associated  with  nonsymmelric  trajectories 
are  resolved  by  measurements  at  another  time  t-^,  if 
the  trajectory  is  again  limited  to  less  than  a  full  circle 
between  t2  and  f  j.  The  speed  distinguishes  the  correct 
trajectory. 

It  is  possible  that  the  ambiguity  of  a  coUinear 
geometry  would  not  be  resolved  by  a  measurement 
at  13  if  the  feature  position  is  also  coUinear  with  the 
first  two  (and  the  observer).  Since  these  are  limited  to 
specific  ambiguous  geometries,  it  is  highly  probable 
that  ambiguities  would  be  resolved  by  matching 
multiple  features  on  an  object 


D.  Existence  and  Uniqueness  for  3-D  Position  Plus 
Doppler 

This  analysis  can  be  extended  to  3-D  motion  if  the 
orientation  of  the  rotation  axis  is  known.  If  the  plane 
of  object  motion  is  unknown,  a  noncoUinear  position 
meastuement  at  another  time  fs  is  required.  Assume 
now  that  Doppler  and  3-D  position  measurements  are 
available.  We  consider  the  case  where  the  observer  is 
not  in  the  plane  of  motion  of  a  given  feature.  Assume 
that  the  observer  is  at  z  =  0  and  the  reference  has  been 
rotated  such  that  measurements  yield  the  same  depth 
(Le.,  Zi(/,)  =  z,(f2)). 

For  this  case  (27)  becomes 

sinp/p  =  ^(f*)cos(p  -  ip.iik)),  k  =  1,2 

(49) 

where 


=  (II  AP.H  cos(£,(/*))]/(2f,i  |^(f*)l)  (50) 


and 


cos(£.(0)  = 


+ yho + 


(51) 


Wth  Ai(tk)  replacing  Ai(tk),  the  existence  and 
uniqueness  analysis  is  identical  to  that  given  earUer. 


Tb  prove  the  converse,  one  can  sljow  that  V’i(^i)  ~ 
Mi2)  and  Ai(ti)  =  A,(r2).  We  then  conclude  that 

Ai(ri)cos(p  -  Mil))  =  ^i(f2)cos(p  -  V’i(t2))  V  p 

(48) 

and  the  trajectory  is  ambiguous  by  Lemma  7.  □ 

Assume  an  object  feature  is  located  as  indicated  by 
the  “o”s  in  Fig.  10(a)  and  (b)  at  times  t  =  ti  and  t  =  t2. 
The  lod  of  the  observer  locations  that  yield  ambiguous 
geometries  are  shown  as  dark  lines. 

If  measured  positions  and  observer  are  coUinear, 
the  ambiguous  trajectories  are  reflections  of  each 
other  as  shown  in  Rg.  11(a).  If  the  observer  lies 
on  a  perpendicular  bisector  of  APi,  the  ambiguous 


E.  An  Example 

Assuming  noiseless  measurements,  uniqueness 
guarantees  that  the  true  motion  parameters  can  be 
found  by  solving  the  measurements  equations  of  any 
feature  pair.  The  motion  parameter  p  and  hence 
u  =  pjti  are  obtained  from 

sinp/p  =  A,(r*)cos(p  -  M^k)),  k  =  l,2 


using  the  method  of  chords  given  in  Appendix  A.  In 
general  one  obtains  two  values  of  p  for  each  /.  The 
value  of  p  that  satisfies  (52)  for  both  A:  =  1,2  is  the 
unique  solution. 
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Once  the  estimate  p  is  obtained,  S  is  estimated  by  it  follows  that 
S  =  lP,(ti)  +  Pim/2  +  icoiiP)/2)BAPi.  (53) 


\dp\< 


For  the  tth  feature,  let  P,(ti)  =  [8  0)^,  P,(ia)  = 

[8  8]^,  r,(ri)  =  IT,  and  r,(r2)  =  0.  Assume  =  1.  The 
two  roots  of  (52,  /:  =  1)  are  p  =  ir  and  p  =  ir/4. 
Similarly,  the  two  roots  of  (52,  *  =  2)  are  p  =  -3r/4 
and  p  =  ir/4.  We  then  set  ^  =  ir/4  b^ause  it  satisfies 
both  equations.  The  center  of  rotation  is  located  at 
S  =  [4  4f . 


V.  SENSITIVITY  OF  MOTION  PARAMETERS  TO 
ERRORS  IN  MEASUREMENTS 

Now  consider  that  the  measurements  contain 
noise  and  the  roots  of  the  measurement  equations 
are  in  error.  The  measurement  equations  are  barely 
overdetermined  and  one  would  not  expect  the  roots 
to  be  highly  robust  to  noise.  The  use  of  such  roots 
in  an  efficient  estimator  is  discussed  in  [24].  As  the 
density  of  the  measurement  errors,  estimation  bias,  and 
estimation  variance  are  not  available,  a  complete  noise 
analysis  is  not  possible.  However,  we  can  calculate  the 
derivative  of  the  motion  parameters  with  respect  to 
the  measurements  and  address  the  cases  for  which 
it  is  not  bounded.  Though  not  totally  rigorous,  the 
measurement  gradient  is  composed  of  reciprocals  of 
the  derivatives  given  here.  The  measurement  gradient 
is  used  for  calculating  the  error  gradient  and  Hessian 
for  nonlinear  minimization. 

Measurement  noise  can  change  the  parameters  of 
(27)  such  that  roots  do  not  exist  particularly  if  Ai{tk)  is 
near  Acrit-  We  show  that  the  solution  p  can  be  defined 
such  that  the  error  in  the  estimate  is  bounded  and  goes 
to  zero  as  the  measurement  errors  go  to  zero.  This  is 
required  for  nonlinear  minimization. 

Tb  simplify  the  derivation,  we  use  the  following 
alternative  definitions 


dp 


The  equation 


2r,,r,(/*) 

(54) 

?,(4)  =  -ta)Bi(tk). 

(55) 

^  =  Ai(tk)zo&{p  -  ^,(f*)) 

(56) 

still  holds. 

Using  the  definition  of  a  total  derivative  for  the 
parameter  p, 

+  -  dri(tk) 
df-iitk) 


dAP. 
dp 


dfi{tk) 


IMAP, II  + 


M^(4)|- 


dp 


dP.{tk) 


(58) 


Here,  T  denotes  the  transpose  and  vector  norms  are 
/^-norms.  From  (58)  it  is  sufficient  to  show  that 


dp 

dp 

dp 

dP(tk) 

’  dAP 

’  dhOk) 

<  00. 


(59) 


Differentiating  (56)  with  respect  to  the  unspecified 
motion  parameter  r]  and  also  substituting  from  (56)  to 
remove  dependence  on  Ai(tk)  yields 


I 


^  sinp  .  , 
0k))+ 


V',{4)) 


=  cos^(p  -  V’,(tt)) 


dAi(tk) 

dt) 


For  T}  =  AP„  the  partials  are 
dAi{tk)  sinpAP, 


dAPi 


pcos(p- V',(4))ltAP,|p 
d'^iitk)  ^  sgn(4  -f„)PPg,(,t)(l)P<(4) 
dAP  l|P,(t*)lll|AP.|| 

The  right-hand  side  of  (60)  becomes 
sinp 


dij 


(60) 

(61) 

(62) 

(63) 

(64) 


p|(APi|p 

We  have  used  the  identity 

Note  that  there  is  a  pole  at  ||APi||  =  0.  If  (|AP,||  =  0 
we  conclude  that  the  motion  class  P,  €  C2  UC3  UC4. 

For  T)  =  r,(tt),  it  would  appear  that  there  are 
poles  at  r,  (/*)  =  0.  However,  upon  more  careful 
examination,  poles  cancel  and  the  only  pole  left  is  the 
aforementioned  pole  at  ||AP,||  =  0. 

For  tj  =  Pi{tk),  the  partials  are 


=  {0  of 

dPitk)  ^  ' 

d^jjtk)  ^  sgn(tfc  -  ta)BPi(tk) 

dPitk)  ||P.(t*)||2  • 

The  right-hand  side  of  (60)  becomes 


sinp 


sin(p  -  V>,(4)) 


sgn(tfc  -  ta)BPiitk) 


(57) 


p  “  .  mm?  ■ 

Thus,  there  is  a  pole  at  ||P/(ti)|l  =  0.  The  case 
||Pi(t*)||  =  0  is  easily  detected  and  not  expected  to 
occur  in  practice. 


(65) 

(66) 

(67) 
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The  derivative  fails  to  exist  if  the  coefficient  of 
dp/dr\  in  (60)  is  zero,  and  the  right-hand  side  is 
non-zero  (25].  This  happens  when  p  is  the  solution  of 


tanV’Kfjk) 


p  -  sinpcosp 
sin^;? 


(68) 


Noting  that  tanV»,(tk)  =  tanV’;(t*),  this  equation 
is  immediately  recognized  as  the  definition  of  the 
existence  boundary.  For  continuity  across  the  existence 
boundary  we  redefine  p  as 

{Either  solution  of  sin  pfp  =  Ai(tt)cos(p  - 

if  a  root  exists  . 

Pmt  else 

(69) 


Though  dpfdr]  does  not  exist  at  the  boundary,  the 
change  in  p  due  to  a  small  error  in  any  measurement 
is  bounded  and  decreases  to  zero  as  the  measurement 
error  approaches  zero  which  is  illustrated  as  follows. 

Let  p^^^  be  the  true  value  of  p  and  let  p^"^  be  the 
calculated  parameter  from  noisy  measurements.  Then, 
for  any  increase  in  ri(tk),  even  if  the  change  causes  the 
roots  of  the  measurement  equations  to  not  exist, 

(70) 

Furthermore,  (pcnt  -  —►  0  as  the  true 

measurements  approach  the  existence  boundary. 

But  if  t;  =  AP,  or  Pi(tk)y  then  pan  is  affect^  by 
the  measurements.  In  this  case,  let  be  the  value 
of  Pent  without  noise  and  be  the  value  with  noise. 
Then 


_  ^(0),  +  (71) 

The  second  term  may  be  approximated  by 


dp^ 

drj 


dr]  = 


dn 

dfiitk)  dri 


(72) 


using  the  chain  rule.  The  partials  of  V’,(ft)  are  given  in 
(62)  and  (66).  From  (33) 

djerit  ^  pin  +  sin^(p„it)  -  2pcritsin(pcrit)cos(pcrit) 

drpi(tk)  2sin(pcrit)(sin(pcrii)- Peril  cos(pcrit)) 


(73) 


Both  denominator  factors  have  perit  =  0  as  their  only 
root  on  the  interval  (-x,7r)  and 


p-o  drpi(tk) 


=  3/2. 


(74) 


Therefore  \p^^^  -  p^riil  is  bounded  on  that  interval 
As  V>i(tt)  —*  ±ir/2.  Peril  — ►  itr.  Furthermore,  the 
derivative  in  equation  (73)  tends  to  infinity  at  these 


points.  If  without  noise  IV’i/t*)!  >  1^/2,  but  due  to  noise 
|V’j(<*)|  <  x/2,  we  can  redefine  p^*,  =  ±x  which  is  its 
value  at  the  boundary  and  equation  (71)  applies. 

Unlike  p  for  which  the  effect  of  a  small  change  in 
a  measurement  is  bounded  for  all  interesting  cases, 
an  infinitesimally  small  change  in  p  can  cause  a 
large  change  in  S  near  p  =  0  or  ±x.  Fortunately,  p 
is  calculated  before  5  so  this  case  is  detectable.  A 
trivial  remedy  is  to  use  the  straight-line  motion  model 
ii  -Pm  <  p  <  Pm  for  some  constant  p„.  Tb  preclude 
p  =  ±x  (and  l|APi|l  w  0)  one  places  a  lower  limit  on 
the  data  sampling  rate.  Assuming  these  constraints 
have  been  met,  we  disregard  these  cases. 

Substituting  Paj  =  (P,(/2)  +  Pi{t\))/2  in  (53)  we 
have 


11 

(75) 

>  (cot(f>)/2)B 

(76) 

^  =  ~l-  BikPi 

dp 

(77) 

where  /  is  the  2x2  identity  matrix.  Clearly,  no 
additional  poles  exist. 


VI.  CONCLUSIONS 

We  have  shown  that  unique  motion  parameters  can 
be  obtained  from  a  single  feature  match  for  position 
plus  range-rate  measurements  with  the  exception  of 
a  few  specific  geometries.  Geometric  constraints  for 
uniqueness  and  existence  of  motion  parameters  have 
been  given.  The  motion  model  uses  common  motion 
parameters,  parameters  that  describe  the  motion  of 
all  features  associated  with  a  rigid  object  Because 
each  feature  match  (two  frames)  uniquely  determines 
the  motion  parameters,  motion  can  be  estimated  for 
each  feature  pair.  The  result  is  a  significant  increase 
in  occlusion  tolerance.  Finally,  the  sensitivities  of  the 
motion  parameters  to  small  changes  in  measurements 
are  given.  All  sensitivities  are  bounded  and  the  errors 
in  motion  parameters  tend  to  zero  as  the  measurement 
errors  approach  zero. 

Several  issues  must  be  addressed.  Since  a  single 
feature  association  uniquely  determines  the  motion 
parameters,  features  may  be  associated  using  the 
common  motion  paradigm.  But,  the  association  of 
features  without  a  motion  estimate  has  yet  to  be 
demonstrated  or  analyzed.  Furthermore,  sequential 
multiple-feature  motion  estimation  with  tolerance  to 
errors  in  feature  association  needs  to  be  demonstrated. 
Also,  the  circular  motion  model  is  not  adequate 
for  many  applications.  The  model  can  be  extended 
by  allowing  the  center  of  rotation  to  move  with 
constant  velocity  or  allowing  the  plane  of  rotation 
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to  be  unknown.  If  the  measurements  include  3-D 
position  plus  Doppler,  the  motion  parameters  may  be 
uniquely  determined  for  both  extensions.  Finally,  the 
theoretical  sensitivity  analysis  needs  to  be  completed 
and  compared  with  numerical  results. 

APPENDIX  A.  FINDING  ROOTS  OF  EQUATION  (27) 

Section  IV  shows  that  (27)  has  at  most  two  roots  on 
the  interval  These  roots  are  also  roots  of 

F(j>)  =  ^,(f*)cos(p  -  V>i(*k))  -  sinp/p.  (78) 

We  can  redefine  F(p)  as  a  circular  function  that  wraps 
around  from  —x  to  x  by  constraining  its  argument  to 
the  interval  (— fl’,jr].  Since  F(—x)  =  F(x)  the  redefined 
function  is  continuous. 

The  method  of  diords  is  used  to  find  the  roots  of 
F{  )  if  th^  exist  This  method  requires  a  starting  and 
ending  point  such  that  the  function,  F(  ),  changes  sign 
on  the  interval  between  these  points. 

First,  assume  0  <  lV>»(t*)|  <  xjl.  If  roots  exist, 

F(pait)  =  Ai{tk)cas(pmi  -  ti(tk))  -  sinperit/Pcri«  >  0 

(79) 

equality  indicating  that  both  robts  are  equal  to  pcnt- 
Note  that 

F(pcrit  ±  JT)  <  0.  (80) 

Therefore,  we  use  pcrft  and  p^,  -F  t  as  the  starting  and 
ending  points,  respectively,  in  the  search  for  one  root 
and  Peril  and  perit  -  x  for  the  other. 

Next  assume  x/2  <  |V»i(4)l  <  x.  Since  two  roots  arc 
known  to  exist,  no  existence  test  is  necessary  and  pcnt 
is  not  defined.  Here  F(x)  =  F(~x)  >  0  and  F(0)  <  0. 
Therefore,  we  use  x  and  0  as  the  starting  and  ending 
points,  respectively,  in  the  search  for  one  root  and  -x 
and  0  for  the  other  root 
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